#ifndef __POSITION_H__
#define __POSITION_H__

#ifdef __cplusplus
extern "C"
{
#endif
#include "fc_sensors.h"
#include "usercmd.h"
#include "pid.h"



    // extern pid_obj_t pidData[PID_POSITION_VX];
    // extern pid_obj_t pidData[PID_POSITION_VY];
    // extern pid_obj_t pidData[PID_POSITION_VZ];
    // extern pid_obj_t pidData[PID_POSITION_X];
    // extern pid_obj_t pidData[PID_POSITION_Y];
    // extern pid_obj_t pid;
    void positionInit(void);
    void positionPidInit(float dt);
    void positionPidUpdate(setPoint_t *setPoint, zdrone_state_t *state, float *thrust, float dt);
    void positionResetAllPID(void);

#ifdef __cplusplus
}
#endif

#endif
